Change invariant scene recognition by an agent

ABSTRACT

A technology can be provided for change invariant scene recognition of an environment by an agent that uses image sensors to capture images. An example method can include grouping the images into situation image sets to form an image database. A navigation image can be captured by the agent at the agent&#39;s current location. Another operation can be searching through images by separately loaded situation image set to identify images that are a probable match for the navigation image. Error values can be computed between the navigation image and situation image sets. A probability can be calculated that situation image sets are to be used as a relevant situation image set based on the error values. Then the relevant situation image set can be searched for matching purposes with the navigation image while the error value is below a defined threshold.

BACKGROUND

Automated agents can provide important services for humans. Examples of an automated agent can be a simple autonomous robot to provide services to an elderly person or to patrol a workplace at night. In addition, other automated agents can be a phone or vehicle that can provide navigation using captured images. A component of accomplishing navigation tasks is the ability to localize or estimate the current location of the agent and navigate reliably to reach locations in the environment.

The more affordable these agents are, the more likely such agents are to become commonly used. Some current robust techniques for agent localization and navigation employ high-precision laser sensors that provide reliable metric readings for surrounding objects. However, such high-end lasers are typically expensive, and can be too expensive to use in an agent where the cost of the agent is constrained.

Another less expensive alternative is to use cameras. While modern cameras provide excellent images for relatively low cost, using these images for localization and navigation is challenging because the images do not directly provide metric information about the environment. Instead, agents can avoid maintaining a metric map of the environment and operate directly in image space. A topological navigation can construct a graph of locations, where edges denote direct access between location nodes. Locations can be identified by sensor readings, typically pre-recorded images from a camera assigned to specific locations. An image representation can also be replaced by a condensed set of features extracted from the image to support rapid similarity computations. Then, the agent can navigate from image to image using a technique called visual homing. A well known problem that arises when using imperfect sensors is a perceptual aliasing problem, where multiple locations appear similar or even identical.

Furthermore, when a global positioning system (GPS) or any global localization scheme is not available, navigation has to be robust to illumination changes or any other changes in the scene, particularly with indoor navigation. Visible image sensors used for scene recognition can suffer from increased error when the scene illumination changes or an object in the scene moves, and an agent may not able to properly match scenes even with relatively minor changes.

SUMMARY

This summary is provided to introduce a selection of concepts in a simplified form that are further described below in the detailed description. This summary is not intended to identify key features or essential features of the claimed subject matter, nor is it intended to be used to limit the scope of the claimed subject matter. While certain disadvantages of prior technologies are noted above, the claimed subject matter is not to be limited to implementations that solve any or all of the noted disadvantages of the prior technologies.

Various examples are described of a technology for change invariant scene recognition of an environment by an agent that uses image sensors to capture images. An example method can include the operation of grouping the images into situation image sets for locations and edges of a navigation graph to form an image database. A navigation image can be captured by the agent at the agent's current location. Another operation can be searching through images by separately loaded situation image set from the image database to identify images that are a probable match for the navigation image. Error values can be computed for matches between the navigation image and situation image sets. A probability can be calculated that situation image sets are to be used as a relevant situation image set based on the error values. A further operation can be searching the relevant situation image set for matching purposes with the navigation image while the error value is below a defined threshold.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a block diagram illustrating an example of a system for change invariant scene recognition of an environment by an agent.

FIG. 2 is an example of a flowchart illustrating a method for change invariant scene recognition of an environment by an agent.

FIG. 3 is a block diagram illustrating components of a robot for change invariant scene recognition.

FIG. 4 is a flowchart diagram illustrating an example of light invariant scene recognition in an environment by an agent.

DETAILED DESCRIPTION

Reference will now be made to the exemplary examples illustrated in the drawings, and specific language will be used herein to describe the same. It will nevertheless be understood that no limitation of the scope of the technology is thereby intended. Alterations and further modifications of the features illustrated herein, and additional applications of the examples as illustrated herein, which would occur to one skilled in the relevant art and having possession of this disclosure, are to be considered within the scope of the description.

This technology can provide change invariant scene recognition for an agent. This change invariant approach can include image recognition technology to match navigational images with previously captured images for scenes by extracting high level signatures and features. Previously captured images can be grouped and stored together (e.g., “fused” together) and tagged based on a capture time and location or a capture event. So, images can be grouped together based on certain times or scene conditions, for example, images taken in a 30 second interval, images captured at different times of day, or images taken during various weather conditions.

As a navigation image is captured and compared against an image set that is temporally related, a probability can be computed that represents how likely future navigation images from the current location are to match with images in the image sets. The result is that the image set with a high probability (e.g., the highest probability) can be compared with the navigational image first. Comparing a navigational image against the image set with a high probably of matching can reduce the time taken to find a match and improve overall performance.

FIG. 1 illustrates a system for change invariant scene recognition of an environment by an agent 102. An agent may be a cell phone, a device with a web camera, a topological navigation device, or an autonomous robot. The system can include an image camera 110 using image sensors to capture images for the agent. The images may be grayscale depth images, colored visual images, or grayscale visual images.

A grouping module 120 can group the images into situation image sets. These situation image sets can be associated with locations and edges of a navigation graph. More specifically, images taken for a situation can be separated into different situation image sets, and this avoids storing every image in the same database without any particular organization. The “situational association” of the images means that the situational environment of a scene was similar when images in the set were captured. For example, an image set can be captured at a social occasion (e.g., a birthday party) or an image set may be captured with respect to objects in a location (e.g., artwork in a room). This means that a situational image set can be captured based on the way an agent is placed in relation to its surroundings or the agent's location. One useful situational association can be grouping images into sets from the same location. Another example of a situational image set can be an image set grouped based on a defined situation criteria, such as a collection of images of one physical location taken across many days during the same light and weather conditions. An image set can also be a temporal image set with images based on a time of capture at a specific location and this is a sub-category of the situational image sets. Images can also be grouped together based on just the time of capture. In another example, several images may be captured by an agent at one time as instructed by a user or a sequence of images can be captured when certain location oriented criteria are met (e.g. a specific piece of furniture is observed, such as a couch or piano).

An image database 112 can contain and store the situation image sets. The images may be stored in a database where each situation image set has a separate storage location. An example of a storage location can be a directory, folder, or another database or operating system sub-division where a group of temporally related images can be stored as a group. Alternatively, the images can be grouped and stored in a relational database or object-oriented database.

A query module 130 can query the image database by obtaining an image signature from a navigation image that is compared with image signatures for situation image sets. The details of obtaining image signatures will be discussed later. These situation image sets can be loaded individually by set (i.e., as separate sets) from the image database. The query module can still search through every image in the database if desired but each situation image set can load as a group.

As navigation images are acquired, the query module can first start matching against the same situation image set as long as a matching error is small. The matching error can be computed based how closely interest features match in the images being compared. The matching error can be an unscaled error value, and the error can be determined as being significant when the error exceeds a threshold value. When a situation image set has a small matching error as compared to a plurality of situation image sets that are being used, a probability can be calculated that this is the situation image set that can be used for most of the image comparisons until the error value increases, which indicates that the location of the agent has changed significantly. Narrowing down the searching based on situationally related images can avoid scanning every image in the database for every query or match process.

A probability module 140 can calculate a probability that a selected situation image set is to be used as a relevant situation image set. In one configuration, the most relevant situation image set can be identified. This means that a relevant situation image set can identified as the image set against which incoming navigation images can be compared because the relevant situation image set is likely to have an image that can currently match with the navigation image.

A feature matching module 150 can identify images in the relevant situation image set (e.g., the most relevant temporal set) that are similar to the navigation image and provide a navigation location for the agent. Global image signatures and local depth image features can be stored and can be used to robustly determine similarity of the navigation image to images in the situation image set to a level of accuracy that allows real-time navigation and localization. The details of obtaining features from the images will be discussed in more detail later.

Instead of storing a state for the agent that can represent the location of the agent, the state may be the situation image set that is active. A transition probability can be tracked that determines when a change may be made to search a different situation image set, and this transition probably can have a minimum or maximum threshold that allows the agent to change the image sets that are being searched in a variety of matching situations.

The agent can have a navigation module 170 to navigate from one navigation location to another navigation location. The navigation module can perform a number of tasks. First, the navigation module can determine the location of the agent within the environment in a probabilistic manner. In operation, the navigation module can generate a plurality of probabilistic beliefs (“beliefs”) that identify the likelihood that the agent is associated with different locations identified in a directed graph. This means that at any given time, the navigation module can identify the location of the agent 102 using a probability density function, rather than specifying the physical coordinates (e.g., Cartesian coordinates) of the agent within the environment. Further, the navigation module can use probabilistic techniques to assess the location of the agent along a particular transition path.

In addition, the navigation module can allow the agent to navigate through the environment based on a probabilistic assessment of location. To this end, the navigation module may include a high-level (HL) control module and a low-level (LL) control module. The HL control module can identify a plurality of votes for different respective locations within the directed graph or navigation graph. The votes can make different respective recommendations for actions to be taken, based on the “perspective” of different locations in relation to a destination location being sought. The HL control module can modify the votes by the above-described probabilistic beliefs (and, in some cases, cost information) to provide weighted votes. The HL control module can then select an action based on considering the weighted votes. Example actions include “do nothing” (in which the agent 102 takes no action), rotate (in which the agent rotates in place at a particular location), navigate (in which the agent navigates along a transition path), and explore (in which the agent moves throughout the environment without regard to a destination location).

In performing the above-described tasks, the navigation module 108 may rely on a feature matching module 150. As discussed, the feature matching module can assess the similarity between a navigation image (i.e., an input image) and any image associated within the directed graph, referred to herein as a graph image. These assessments can be made as separate situation image sets are loaded. The feature matching module can perform this matching operation using any technique. For example, the feature matching module can identify features associated with the input navigation image and determine the extent to which these features match features associated with images in a situation image set in the graph. In one example, matching can be performed by first comparing one or more global signatures associated with the navigation image with global signatures associated with the situation image sets. This fast comparison produces a subset of previously stored situation image sets that are possible matches for the input image. The approach then performs matching on a higher granularity by comparing features within the navigation image and features within the subset of images in a situation image set. A number of image matching methods can also be used, such as a standard Harris-type feature comparison algorithm without the use of global signatures, etc.

A pruning module 160 can be provided to remove situation image sets that have not been utilized in navigation for a period of time due to a reduced amount of matching. There may be some situation image sets in the database that are not matching with navigation images and this may continue over a period of time. Such situation image sets can be removed from the database when a threshold defined for the period of time is reached. For example, if more than 30 or 60 days has passed since a match has been made with a situation image set, then the situation image set can be removed from the database. Alternatively, a situation image set can be removed from the database when a garbage collection operation or storage deallocation process is being performed, if the situation image set has not been matching with relatively recent navigation images.

The agent 102 can further include a computing device 180 with a hardware processor device 180, a hardware memory device 182, a local communication bus 184 to enable communication between hardware devices and components, and a networking device 186 for communication across a network with the compute nodes, processes on the compute nodes, or computing devices on other agents.

The use of images combined into groups or image sets that are situationally associated results in an image matching or searching approach that is generally illumination invariant and also responds robustly to dynamic changes in the environment. For example, dynamic changes in the environment can include changing objects (e.g., furniture, toys, etc.) or people in the scene. This technology can match situation image sets having images that are more relevant to a navigation image and so exact matches may not be needed. In addition, situation image sets with changes to the scene that do not match the current scene will be unlikely to be used. The use of group level image matching also applies to both indoor and outdoor scenes when topological or image based matching is being used (i.e., GPS is not available).

FIG. 2 illustrates an example of a method for change invariant scene recognition of an environment by an agent that uses image sensors to capture images. The agent can be an autonomous self-propelled robotic device, a cell phone, a web camera on a laptop, a vehicle, a mobile device, or a mobile game controller sensor. The image sensor(s) can capture images using color sensors, grayscale sensors, or a depth image sensing sensors and processing.

The method can include the operation of grouping the images into situation image sets that may be identified by tags for locations and edges of a navigation graph to form an image database, as in block 210. Each situation image set can include multiple discrete images taken during a certain period of time at a specific location, and there can be multiple captures that form multiple situation image sets from same room. For example, a situation image set can be created by a user initiating a situation image set capture. Specifically, a user may take a robot or a camera in a cell phone on a tour and designate certain places where a set of images are captured. The user may inform the robot or phone that a location is the kitchen and capture a set of situationally related images for that location to form a situation image set.

A navigation image can also captured by the agent at the agent's current location, as in block 220. The navigation image can be an image at a location the agent is current located. The images can then be searched through by separately loaded situation image sets from the image database to identify images that are a probable match for the navigation image, as in block 230. Because the images are separated into situation image sets, comparison of the navigation image with the situation image sets can take place the using the same vision processing scheme to compare across captures taken at different times with no special processing and no need to detect current illumination conditions. When the situation image set has been searched, a good image match, out of the most relevant capture set can be used.

A further operation can be computing error values for matches between the navigation image and situation image sets, as in block 240. The error values can be unscaled real numbers with no upper limit. Alternatively, the error values can be scaled with respect to a minimum or maximum expected error value.

A probability can be calculated that situation image sets are to be used as a most relevant situation image set based on the error values, as in block 250. In addition to calculating the probability that a situation image set is relevant (e.g., most relevant), a transition probability can also be computed. The transition probability can determine whether the navigation image match is initially searched for in the current situation image set or whether the agent will change which situation image set is initially searched for a match. As the transition probability increases, then the probability that a different situation image set will be searched first for the next navigation image is higher and more likely. For example, the transition probability can increase as the error for the match increases.

In one configuration, the agent can track a relevant situation image set for individual locations and edges of the navigation graph. For a location or edge, a situation image set reference or value may be stored that associates the relevant image set with the location or edge. This allows the searching for a match to the navigation image to be faster because a more likely image set for a match can be searched first, and if a desired match is not found then other situation image sets can be searched.

The relevant situation image set can also be searched for image matching purposes with the navigation image while the error value is below a defined threshold 260. While the error value is low, the incoming navigation images can be searched for in the relevant situation image set. The probabilistic model can help prioritize the expected relevant situation image set to compare with the navigation image. This can avoid the computation time that would otherwise be used to compare to navigation images with a large number of the images stored in the database when good matches are coming from the one situation image set.

In one configuration, the agent can check for situation image sets that have had consistently high errors in matching results over the defined period of time. Situation image sets that are consistently not matching with navigation images that are captured by the agent are image sets that may have an old view of a location or edge. If a number of objects have been rearranged in a scene or a specific lighting arrangement is not used anymore, then the situation image sets associated with these scenes can be discarded.

This technology can make image matching in an agent more efficient because initial decisions are made about the situation image sets that will be initially used for matching and processing. The matching process assumes that for every real location (e.g., bedroom A) there are one or more groups of images that are situation image sets. Based on the calculated error values, a good set of situationally related images can be selected for the matching against the navigation image using the computed probability, and most often the best set will be selected. This image group level decision can also avoid searching through every image in an image database which can make the technology more efficient. Searching through every image in the database can also increase the chance of false positives.

Robot Implementation

While a high level overview of technology has been discussed that can be used with various agents, such as cell phones, web cameras on laptops and autonomous agents, a more detailed example of using this technology in an autonomous robot can now be described.

A robot using appearance-based localization can compare a currently captured image or navigation image taken from a robot's camera to a set of pre-recorded images or a situation image set in order to estimate the current location of the robot. A graph of situation image sets can be maintained to model the dynamics of the image sequences. The graph can also be used to navigate in the space of images. This may allow a robot to be deployed in a relatively small environment, such as a house, or a work place, and enable the robot to robustly navigate the environment after minimal training.

When the robot is introduced into a new environment, a human may give the robot a partial ‘tour’ of the environment by visiting a set of locations and the human can provides labels by names. Throughout the tour the robot can collect images of the locations and the paths between locations, thus building a topological map. The map may be a two-layered map. The higher layer can be a graph where vertexes represent locations and edges represent paths. For the paths, a low level image sequence can be maintained that can later allow the path to be traced.

The robot can also group the images into situation image sets that may be identified by tags (e.g., kitchen, living room, etc.) for locations and edges of a navigation graph and store the situation image sets in a directory tree structure on an operating system. For example, a directory may be provided for the kitchen and subdirectories can exist for each situation image set.

A navigation image can also captured by the robot at the robot's location as the robot moves around. Separately loaded situation image sets from the image database can then be searched to identify images that are a probable match for the navigation image. When the situation image set has been searched, then the best image match from the most relevant capture set can be used. Error values can be computed for matches between the navigation image and a situation image set. A probability can be calculated that situation image sets are to be used as a most relevant situation image set based on the error values.

In one configuration, the robot can track a most relevant situation image set for individual locations and edges of the navigation graph. This allows the match searching for the navigation image to be faster because a more likely image set for a match can be searched first. The most relevant situation image set can also continue be searched for image matching purposes with the navigation image while the error value is below a defined threshold. The probabilistic model can prioritize the expected most relevant situation image set to compare with the navigation image. This can avoid the computation time that would otherwise be used to compare to navigation images with a large number the images stored in the database when good matches are coming from a single situation image set.

In another configuration, the robot can check for situation image sets that have had consistently high errors in matching results over a defined period of time. Situation image sets that are consistently not matching with navigation images that are captured by the robot are image sets that may have an old view of a location or edge, then these situation image sets can be discarded.

To provide a robust localization estimation, Partially Observable Markov Decision Process (POMDP) belief tracking can be used to measure and update the probability of each possible robot location, given the previous observations. A higher level belief probability can be maintained for the vertexes and edges of the graph, and a low level belief probability can be maintained for the current location within each edge. When the robot is given a command to navigate to a destination, the robot can compute the cost of navigation from each location. Then, decisions can be made based on the expected cost of actions, and the robot can navigate to a destination attempting to minimize the cost, whether the cost is time or energy consumption.

Localization and Navigation

When using a topological navigation approach, the robot can create a graph, where each node is composed of a set of sensor readings, and edges between two nodes denote direct reachability. Given the graph, the agent can navigate to a destination by traversing the graph, each time attempting to reproduce the sensor readings associated with the next node. Many topological navigation methods use images from cameras.

One possible method for moving between nodes associated with sensor readings is called visual homing. In this technique the robot tries to achieve the same sensor readings as pre-captured target readings. For example, in the case of images, a two-dimensional (2D) transformation can be computed between two images, specifically the current image captured by the robot camera and the target image. Given this transformation, an angular direction can be computed that may reduce the magnitude of the transformation, thus causing the current image to look more like the target image.

As working directly with high dimensional sensor readings (e.g., images) is computationally intensive, a common approach is to extract a set of features or interest points from the images. Then, the two images can be compared through the sets of features in the two images. This comparison can be invariant to scale, distance, rotation, and other transformations in the image. By constraining the number of features for each image, accuracy can be traded for speed.

Appearance-based localization can use images to represent locations and use image comparisons to detect whether the current captured image can be associated with a known location. Such methods may be augmented using some motion models and topological information to restrict the space of candidate locations.

Partially Observable Markov Decision Process

A robot navigating through an environment using imperfect sensors and motors can be modeled by a Partially Observable Markov Decision Process (POMDP). A goal-based POMDP can be a tuple <S, A, tr, C, G, Ω, O, b₀> where:

-   -   S is a state space. Each state can encapsulate relevant         information about the environment used to make a decision.     -   A is a set of actions. The agent can influence the environment         by executing actions. Actions effects are stochastic, and tr(s,         a, s′) pr(s_(t+1)=s′|s_(t)=s, a_(t)=a) is the probability of         executing a in state s and transitioning to state s′.     -   C(s, a) is a cost function associating a cost with a state and         an action.     -   G ⊂ S is a set of goal states, specifying the desirable         destination of the navigation.     -   Ω is a set of observations, or possible sensor readings.     -   O(s, o)=pr(o_(t)=o|s_(t)=s) is the probability of observing o in         state s.     -   b₀ is a probability distribution over start states.

As in a POMDP, the real world state s is not directly observable, and a belief can be maintained that is a probability distribution over possible world states. Given a current belief b, an action a, and an observation o, the next belief b′ can be computed by:

$\begin{matrix} {{b^{\prime}s^{\prime}} = \frac{{O\left( {s^{\prime},o} \right)}{\sum\limits_{s \in S}{{b(s)}{{tr}\left( {s,a,s^{\prime}} \right)}}}}{\kappa}} & (1) \end{matrix}$ where κ=pr(o_(t+1)=o|b_(t)=b, a_(t)=a) is a normalization factor. The optimal policy of the POMDP can be represented as a mapping from beliefs to actions.

Robot Hierarchical Topological Model

As discussed before, a two-layered representation can be used to model an environment graph. On an upper layer, vertexes can denote locations in the environment, and edges can denote paths between locations. On the lower layer, each edge can be represented by a sequence of images. This hierarchical representation can provide both an abstract representation for making high level navigation decisions, and an explicit low level path representation that may be translated into motion commands.

In the upper layer topology, the known locations can be captured in the environment as nodes. Each node can be associated with a set of images that were taken in that location. Thus, the set of images becomes the identifying sensor readings for the location.

A POMDP model can be defined over the graph G=<U, E>. Each node and edge in the graph may be a state—S=V∪E. A set of high level navigation commands can be defined:

-   -   RotateAndFindEdge—turn around without moving forward, looking         for a specific edge, given as a parameter to the action.     -   Navigate—navigate along an edge (path). This action is         applicable for edges.     -   Explore—heuristically move towards the open spaces. This command         can be used when the robot is unsure of its location, or when         the robot is stuck and cannot move due to obstacles.     -   DoNothing—a no-op command, typically used when the robot has         reached the robot's destination and awaits a new command.

Most of these commands move the robot stochastically between states. The transition probabilities can be defined through relations between states. For example, ifs is a location, s′ is an edge moving out of s, the robot executes the action a=RotateAndFindEdge with s_(g) as the goal edge, then tr(s, a, s′)=p>0, and tr(s, a, s_(g))>tr(s, a, s). For any other state, location or edge, not going out of s, the transition probability is 0. The following relations between state may be supported: origin location of edge, target location of edge, edge going out of location, edge entering a location, edges with shared origin, edges with shared destination, reverse edge. The transition probabilities can be tuned to fit the domains, as learning the probabilities from experience may require many trials, and the robot is desired to be deployed rapidly in real environments.

Action costs can be modeled through execution time. Such costs can be computed directly from the sequences of captured images and the robot properties. For example, if time stamps are maintained for images, the cost of a navigate action can be defined based on the time difference between the first and last image. The time the robot takes to complete a full 360±rotation can also be computed.

The observation set Ω is the set of the possible images. The system typically cannot maintain or iterate over this set explicitly. An observation function can be defined using an image similarity engine sim(i,i′). The image similarity engine will be discussed in detail later. The POMDP method assumes that an engine is provided that, given two images, provides a similarity score. This engine can compute a similarity score for an image and a state: sim(s,i)=max_(i′εs)sim(s,i′)  (2) maximizing over the images i′ associated with a states whether the state is a location or a path. The max can be used as the aggregator rather than other options (e.g., the mean similarity of images), as images are taken from different angles in a location, or from different positions along a path. Therefore, it is reasonable that just one or two images from each state match the captured image.

When computing a belief update (Equation 1), a state-image similarity score can be used instead of an observation probability, thus making the assumption that sim(s, i) ∝pr(i|s). The advantage of this approach is that κ=pr(o|b,a) does not need to be computed, as the new belief state can be normalized after computing the new pseudo-belief in the numerator of Equation 1 using the similarity metric.

A lower layer edge representation can also be provided. For edges, a sequence of images can be captured when the edge is introduced. This sequence can be used both for localizing within an edge and for navigation along an edge. A local belief probability can be maintained over the images within an edge: b(i|s), which is the probability that the robot is currently at image i given that the robot is within state s.

To compute this local belief probability, a POMDP model can be used for each edge, where the states can be the images on that edge. The actions can be moving forward through the edge, or not (any other action). When the robot moves along the edge, the probability of remaining on each image or transitioning to future images is computed based on the distance (whether in metric space or in time) between images and the current velocity of the robot. For example, when the robot moves faster and the images are nearer, the transition probability to the next image in the sequence is relatively high. When the robot moves slower, such as when the robot is moving around corners, the transition probability may be reduced accordingly.

In addition, belief can be injected from other graph elements, such as other paths and locations. For example, when a RotateAndFindEdge action is executed in a location s, a transition into an intersecting edge s′ may occur. In this case, the new belief mass that has transitioned from s into s′: b(s)tr(s,a,s′)O(s′,o)  (3) This new belief mass can be injected into the edge appropriately. For example, when the edge is a path going out of a location, the new belief mass is injected uniformly into the first 5% of the image sequence. When the belief mass is from another edge, such as an edge with a shared origin, the new belief mass can be spread uniformly along the edge. To properly balance between the new belief mass and the existing belief mass on the edge, the local beliefs are first scaled to the overall belief using b(i|s)·b(s), then the new belief mass is injected from other locations. Afterwards, the inner edge transition probabilities are used to compute the next belief state.

When a robot is deployed in a new environment, the two-layered model for that environment can be acquired or learned (i.e., the important locations and the paths between them). It is valuable when the learning phase can have a minimal cost. For example, the robot can follow a human teacher through a tour of the environment. Along the tour, the human will specify important locations in the house. For example, the human may say along the tour, “this is the kitchen”. The robot can then add a new location to the model, labeling it as “kitchen”, and spin around, taking a set of images associated with the new location. When the robot follows the human, the robot can record the images along the path. When a new location is introduced, the robot sets the recorded path as an edge between the previous location and the new one.

Image Similarity Engine

An image similarity engine is designed to rapidly provide a ranked list of N images from the pre-recorded image dataset that best match a given image. For each image the engine computes a similarity score. While this discussion focuses on image similarity, the same methods can apply to other types of sensors, such as depth cameras. This example method uses a two pass process. On a first pass, images that are substantially different are filtered based on crude image signatures leaving a relatively small candidate set C. On the second pass, features that were extracted from the images in C can be compared to provide a matching score.

While high accuracy in relating new images to previously observed images is good, this approach does not find an exact match each time and can easily recover from identification errors. The belief update mechanism may take into consideration the noise in the sensor, whether that noise comes from image blur or from improper feature detection. In both cases, the belief update may be applied such that the noise will not bias the selection consistently towards the wrong images. As long as the similarity scores for the truly similar images is in general higher, the repeated belief update will not be significantly affected by the noisy observations.

In an example of feature detection, a Harris corner detector can be used to extract features from the image. This detector uses the gradient from each pixel to the pixel's neighbors to detect significant changes that typically correspond to corners in the image. The features may then be ranked by strength, and the top features can be maintained for each image. For each feature, a feature descriptor vector can be maintained. The resulting features can be relatively robust to scale, orientation, and illumination. Other types of feature detector can be used too. Examples of other detector methods include the MSER (Maximally Stable Extremal Regions), SIFT (Scale-Invariant Feature Transform), and FAST corner detectors.

In a first pass, local and global signatures can be identified. When an image is introduced into the database, an image signature can be computed based on global image properties, such as color histograms. These properties can be used to compute a property vector that will be used as the signature of the image. A list of possible signature components is below:

-   -   Color histogram: The image can be converted to YCbCr colorspace         and a histogram of pixel intensity distributions can be created         in each color channel. The histogram can provide an imagewide         signature or a global description of the entire image.     -   Thumbnail: The image can be reduced to a smaller pixel image,         across multiple color channels. This thumbnail can also be         represented using a vector to provide another global description         of the image.     -   Feature summary: As comparing the Harris features directly is         relatively costly, a summary of the set of features can be         generated, by computing the mean and variance of the feature         descriptor vectors. As the Harris features are computed locally,         this signature can signal that similar objects appear in the two         images, but not whether the objects are located in the same         place in the two images. This signature thus provides local         information about objects in the image.

In a second pass through the images, the corner features can be computed. As explained before, Harris features can be extracted from each image. In the second pass, a bag of features approach can be used with a K-dimensional tree. The query image or the navigation image received from the robot's camera can be compared with each image in the situation image set. To compare two images the set of Harris features can be used. For each feature in the query image, the best matching feature in the candidate image can be found and their distance can be computed. This approach may select the same feature from the candidate image multiple times, but this can be appropriate for the Harris features that tend in many cases to be grouped around an informative corner. It may be less important in this case to distinguish between the different corner features.

The distances between each feature and its best match can then be summed, and used as an error estimation e_(features)(i,i′). Even though the comparison of corner features results in relatively accurate image matching, the information in the cruder signatures is also valuable. Therefore, the information from the other signatures can be combined together to form a final error estimation e(i,i′) by a weighted sum of the errors from the various components.

The error can then be converted into a normalized similarity measurement using:

$\begin{matrix} {{{sim}\left( {i,i^{\prime}} \right)} = {1 - \frac{{e\left( {i,i^{\prime}} \right)} - e_{\min}}{e_{\max} - e_{\min}}}} & (4) \end{matrix}$ where e_(max)=max_(i′)e(i,i′) is the maximal error within the candidate set and e_(min)=min_(i′)e(i, i′) is the minimal error. While this computation is relatively intensive due to computing the best match for each feature among the features in each image in the candidate set, the computation is feasible because most images are filtered out in the first pass. The above method computes a similarity between the current image and a set of candidate images.

Localization is the task of inferring a current location of the robot within the environment. The probabilistic model allows the robot to be uncertain as to the robot's true location. In general, we consider localization as obtaining a probability distribution over locations and paths or the states of the model. A probability distribution can be obtained from the beliefs that are computed both over the high level and the low level models. The high level model provides an estimation of the probability of being in any location and path. The low level models provide estimations about our current location within edges, assuming that the robot is currently on that edge. Thus, the probability can be estimated that the robot is currently at any location, and also the probability of our location along an edge.

In many cases images from different parts of the environment can look very similar. For example, in an office environment, many corridors may look almost identical. However, as the belief update uses the previous belief and the transition probabilities to compute the new belief, observing occasionally images that are very similar to remote locations has a minimal effect. The probability mass can shift to a new state if the images from that state are consistently better matched with the current image. In that case, the evidence for a different location may be substantial enough to deduce that the previous location estimation was incorrect.

The same problem can arises when the robot navigates along an edge. It often happens that the most similar image along the edge is far from the true location of the robot, either forward or backward. Indeed, the best matched image can move forward or backward along the edge, not displaying a linear advancement. Again, the use of transition probabilities and belief updates do not allow erratic position estimates along the edge and provide a more robust estimator.

FIG. 3 illustrates an example robotic device 300 that uses an image matching system as described. The robotic device can include a digital camera 302. In an example, the digital camera may be configured to capture color, gray scale, and/or depth images of one megapixel or greater.

The robotic device 300 can also include the image recognition system 306 described above. The robotic device may also include a processor, buses and other hardware that can be used in connection with implementing the image recognition system. As an example, the robotic device may include a general purpose processor, a graphics processing unit or other suitable processor or integrated circuit. In another example, an image captured by the robotic device by the camera 302 can be provided to the image recognition system 306, which can determine which image in a situation image set most closely matches the image captured by the camera.

The robotic device 300 further includes a controller component 304 that causes the robotic device to act based at least in part upon the output of the image recognition system 306. For instance, the controller component can control motion of the robotic device 300, and thus may cause the robotic device to move in a particular direction based upon output of the image recognition system. For example, the controller component can use the output of the image recognition system to determine location of the robotic device and can cause the robotic device to move, based at least in part upon the determined location. Furthermore, the controller component can determine orientation of the robotic device based at least in part upon output of the image recognition system.

The robotic device 300 may be or include any suitable robotic device. For example, the robotic device may be or be included in an automated lawnmower or vacuum. In other examples, the robotic device may be included in more sophisticated devices such as in an airplane in connection with an autopilot function, in a rail system that can be used in connection with recognizing hazards along a railway or location of rail stops, in an automobile to inform an occupant thereof of particular landmarks in the field of view of a camera, etc. Other applications are also contemplated and intended to fall under the scope of the hereto appended claims. For example, the image recognition system may be used in any suitable application where image matching is desirable.

Light Invariance

FIG. 4 illustrates a method for light invariant scene recognition in an environment by an agent. Depth images of a scene can be captured using a camera of the agent, as in block 410. The depth images can be captured by a depth camera system. As an example, a depth camera system can identify the scene volume with near-IR (infrared) light. Then a CMOS (Complementary Metal-Oxide-Semiconductor) image sensor can read the light back from the scene, and a computational method can decipher the received light and produce a depth image of the scene.

Visual images can also be captured from the scene, which are correlated to the depth images using the camera of the agent, as in block 420. The correlation between the visual images and the depth images can be that both images cover the same or overlapping areas of a scene. A visual camera of the agent (e.g., a color CMOS image sensor) can capture the color visual light spectrum. The visual camera can be separate from the depth camera, but in some cases the depth camera and visual camera can be integrated. This means that a depth image and a color image of the same scene may be captured.

The interest points in depth images based on depth gradient can also be identified, as in block 430. Interest points can be found using interest point detector methods, as described before, that include: FAST, Harris, and MSER methods that can scan through the image and look for gradient changes.

A depth image is not affected by light so the agent can analyze areas with high depth gradient to identify visual areas of interest. Pixel patches from depth images are low quality grayscale (e.g., coarse geometric). A global signature can also be extracted from depth images that are a histogram, centroid, or thumbnail of the original depth image.

After identifying interest points in the depth images, pixel patches can be extracted from the visual images that correspond to interest points in the depth images, as in block 440. This means that a plurality of interest points can be identified using the depth images, and then corresponding areas in the visual image that have the same coordinates as the area of interest in the depth image can have pixel patches extracted. For example, a depth match may be able to see a corner on couch or door molding but this same area may also have texture and color patterns that can be captured by the color image. Thus, the visual camera can capture the color patterns, texture patterns, or other visual data located at the same point as the interest points in the depth images. In an alternative configuration, the interest points from depth image can be used to identify pixel patches extracted from both the depth image and visual image.

The interest points in images for agent navigation can be matched by using pixel patches from the visual image for the interest points in the depth map, as in block 450. The interest points in a navigation image can be matched to interest points in a visual image from a database using pixel patches extracted from the visual image to identify the agent's current location within a navigation graph.

Using the visual pixel patches from navigation images for an agent is an effective matching method because the visual pixel patches also identify areas of interest in the depth images where there is high gradient. In addition, a depth map is a subset of what is interesting visually in an image. The areas of interest have a high gradient and generally have a visual texture that can be used for effective matching. As a result, this configuration can use a pixel patch from visual image in and/or around areas of interest in the depth map for matching features of interest.

In another illumination invariant configuration, the depth images and visual images can be stored in separate situation image sets. For example, one index of color visual images grouped as situation image sets can be stored and a second separate index of depth images grouped as situation image sets can be stored separately from the visual images. Then the matching can take place with either depth images or visual images depending on which situation image set type has an error value below a defined threshold. As a result, when a scene illumination has changed, the system can automatically pick a situation image set from either the depth image type or visual image types that are matching the best. Alternatively, the matching process can also be made more light invariant by using just the depth images to avoid changes in time of day, weather, or artificial lighting.

Some of the functional units described in this specification have been labeled as modules, in order to more particularly emphasize their implementation independence. For example, a module may be implemented as a hardware circuit comprising custom VLSI circuits or gate arrays, off-the-shelf semiconductors such as logic chips, transistors, or other discrete components. A module may also be implemented in programmable hardware devices such as field programmable gate arrays, programmable array logic, programmable logic devices or the like.

Modules may also be implemented in software for execution by various types of processors. An identified module of executable code may, for instance, comprise one or more blocks of computer instructions, which may be organized as an object, procedure, or function. Nevertheless, the executables of an identified module need not be physically located together, but may comprise disparate instructions stored in different locations which comprise the module and achieve the stated purpose for the module when joined logically together.

Indeed, a module of executable code may be a single instruction, or many instructions, and may even be distributed over several different code segments, among different programs, and across several memory devices. Similarly, operational data may be identified and illustrated herein within modules, and may be embodied in any suitable form and organized within any suitable type of data structure. The operational data may be collected as a single data set, or may be distributed over different locations including over different storage devices. The modules may be passive or active, including agents operable to perform desired functions.

The technology described here can also be stored on a computer readable storage medium that includes volatile and non-volatile, removable and non-removable media implemented with any technology for the storage of information such as computer readable instructions, data structures, program modules, or other data. Computer readable storage media include, but is not limited to, RAM, ROM, EEPROM, flash memory or other memory technology, CD-ROM, digital versatile disks (DVD) or other optical storage, magnetic cassettes, magnetic tapes, magnetic disk storage or other magnetic storage devices, or any other computer storage medium which can be used to store the desired information and described technology.

The devices described herein may also contain communication connections or networking apparatus and networking connections that allow the devices to communicate with other devices. Communication connections are an example of communication media. Communication media typically embodies computer readable instructions, data structures, program modules and other data in a modulated data signal such as a carrier wave or other transport mechanism and includes any information delivery media. A “modulated data signal” means a signal that has one or more of its characteristics set or changed in such a manner as to encode information in the signal. By way of example, and not limitation, communication media includes wired media such as a wired network or direct-wired connection, and wireless media such as acoustic, radio frequency, infrared, and other wireless media. The term computer readable media as used herein includes communication media.

Furthermore, the described features, structures, or characteristics may be combined in any suitable manner in one or more examples. In the preceding description, numerous specific details were provided, such as examples of various configurations to provide a thorough understanding of examples of the described technology. One skilled in the relevant art will recognize, however, that the technology can be practiced without one or more of the specific details, or with other methods, components, devices, etc. In other instances, well-known structures or operations are not shown or described in detail to avoid obscuring aspects of the technology.

Although the subject matter has been described in language specific to structural features and/or operations, it is to be understood that the subject matter defined in the appended claims is not necessarily limited to the specific features and operations described above. Rather, the specific features and acts described above are disclosed as example forms of implementing the claims. Numerous modifications and alternative arrangements can be devised without departing from the spirit and scope of the described technology. 

The invention claimed is:
 1. A system for change invariant scene recognition of an environment by an agent, the system comprising: an image camera configured to use image sensors to capture images for the agent; a grouping module configured to group the images into situation image sets that are identified as being at locations and edges of a navigation graph; an image database configured to contain the situation image sets; a query module configured to query the image database by comparing a first image signature of a navigation image with second image signatures of the situation image sets, wherein the situation image sets are loaded as separate sets from the image database; a probability module configured to identify a selected situation image set based on a probability that the selected situation image set has an individual image that matches the navigation image; a feature matching module configured to identify one or more matching images in the selected situation image set that match the navigation image and to provide a navigation location for the agent based on the one or more matching images; and at least one processing device configured to execute the grouping module, the query module, the probability module, and the feature matching module.
 2. The system as in claim 1, wherein the images are grayscale depth images or visual images.
 3. The system as in claim 1, wherein the first image signature and the second image signatures are global image signatures.
 4. The system as in claim 1, wherein the agent is a robotic agent having a navigation module configured to navigate from the navigation location to another navigation location.
 5. The system as in claim 1, further comprising a pruning module configured to remove some situation image sets from the image database when the some situation image sets have not been used in navigation for a period of time, wherein the at least one processing device is also configured to execute the pruning module.
 6. The system as in claim 1, wherein the probability module is further configured to: determine the probability that the selected situation image set has the individual image that matches the navigation image; and determine other probabilities that other situation image sets have other individual images that match the navigation image, wherein the probability for the selected situation image set is higher than the other probabilities for the other situation image sets.
 7. A method implemented by one or more computer processing devices, the method comprising: obtaining images for an agent, the images being captured with a camera; grouping the images into situation image sets and storing the situation image sets in an image database; querying the image database for first image signatures of the situation image sets and comparing the first image signatures to a second image signature of a navigation image; based on the comparing, determining probabilities that individual situation image sets of the situation image sets have individual images that match the navigation image; identifying a selected situation image set based on the probabilities; identifying one or more matching images in the selected situation image set that match the navigation image; and providing a navigation location for the agent based on the one or more matching images.
 8. The method as in claim 7, wherein the situation image sets are associated with corresponding locations and edges of a navigation graph.
 9. The method as in claim 7, wherein the situation image sets are associated with corresponding locations.
 10. The method as in claim 7, wherein: the grouping further comprises grouping the images within the situation image sets into subsets of the situation image sets based on a time of day or based on weather conditions; and the determining the probabilities further comprises determining the probabilities for the subsets.
 11. The method as in claim 7, wherein the image database is a relational database or an object-oriented database.
 12. The method as in claim 7, wherein the determining the probabilities further comprises computing error values between the first image signatures of the situation image sets and the second image signature of the navigation image and basing the probabilities on the error values.
 13. The method as in claim 12, the method further comprising excluding some situation image sets having corresponding error values above a predetermined threshold when identifying the selected situation image set.
 14. The method as in claim 7, the method further comprising iteratively performing the querying, the determining, and the identifying the selected situation image set until the one or more matching images are found.
 15. One or more computer readable memory devices or storage devices storing computer readable instructions that, when executed by one or more processing devices, cause the one or more processing devices to perform acts comprising: obtaining images for an agent, wherein the images were captured with an image camera using one or more image sensors; grouping the images into situation image sets corresponding to locations of a navigation graph and storing the situation image sets in an image database; comparing situation image signatures of the situation image sets to one or more navigation image signatures of a navigation image; and identifying a selected situation image set based on a corresponding probability that the selected situation image set has an individual image that matches the navigation image.
 16. The one or more computer readable memory devices or storage devices as in claim 15, wherein the comparing further comprises comparing a global navigation image signature associated with the navigation image to global situation image signatures associated with the situation image sets.
 17. The one or more computer readable memory devices or storage devices as in claim 16, wherein the comparing the global navigation image signature and the global situation image signatures produces a subset of the situation image sets for further comparison.
 18. The one or more computer readable memory devices or storage devices as in claim 17, the acts further comprising performing the further comparison by comparing higher granularity features associated with the navigation image to corresponding higher granularity features associated with other images in the subset of the situation image sets.
 19. The one or more computer readable memory devices or storage devices as in claim 15, the acts further comprising: identifying one or more matching images in the selected situation image set that match the navigation image; and providing a navigation location for the agent based on the one or more matching images.
 20. The one or more computer readable memory devices or storage devices as in claim 15, the acts further comprising: computing error values between the situation image signatures of the situation image sets and the one or more navigation image signatures of the navigation image; and determining a set of probabilities based on the error values, the set of probabilities including the corresponding probability, wherein the identifying the selected situation image set further comprises comparing the corresponding probability to other probabilities from the set of probabilities. 